#pragma once
#include "common.h"

class CoordSys {
public:
    CoordSys();
    void XYZ2BLH(const XYZ& xyz, BLH& blh);
    void BLH2XYZ(const BLH& blh, XYZ& xyz);
    void XYZ2ENU(const XYZ& xyz, const XYZ& ref, ENU& enu);
    XYZ XYZ_subtract(const XYZ& a, const XYZ& b);
    double XYZ_norm(const XYZ& xyz);
private:
    double a = 6378137.0;
    double f = 1.0 / 298.257223563;
};